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Abstract of EP0911603 


The position detection method provides the 
position of an object relative to a 3-dimensional 
external coordinate system (4), by detecting the 
position of selected edges or lines of the object in 
relation to a 3-dimensional coordinate system (2) 
within the body of the object, converting them into 
corresponding planar coordinate systems (3) and 
determining the position of each of the latter 
relative to the external coordinate system. A 
device for determining the position of an object 
using an optical method is claimed 
independently. 
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(54) Verfahren zur optlschen Bestimmung der Lage eines raumlichen Kbrpers und Vorrichtung 
hlerzu 


(57) Bei einem Verfahren zur optischen Bestim- 
mung der Lage eines endlichen starren KOrpers in 
einem Koordinatensystem wird zur LGsung der Aufgabe 
ohne Kenntnis der gegenseitigen Lage von Werkzeug 
und Werkstuckbei Verwendung eines Roboters ein ziel- 
sicheres Arbeiten am Werkstuck zu ermOglichen. vor- 
geschlagen, daft aus einer Auswaht von mehreren auf 
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dem starren KOrper vorhandenen Linien oder Kanten 
den Bezug zum kOrpereigenen Koordinatensystem ste- 
hen, jede Unie oder Kante fur sich in einem ihr zugeor- 
deten ebenen Koordinatensystem abgebildet wird und 
da8 die Lage jedes ebenen Koordinatensystems auf 
das raumliche Koordinatensystem bezogen ist. 
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Beschreibung 

[0001] Die Erfindung betrifft ein Verfahren zur opti- 
schen Bestimmung der Lage eines endlichen starren 
KOrpers in einem rftumlichen Kbordinatensystem. 
[0002] Bei der Serienhersteilung mehrteiliger KOrper 
ist es beim Einsatz von Robotern erforderlich, die ein- 
zelnen Bauteile in ricrrtiger Lage und an der richtigen 
Stelle fOr den fertigzustelienden dreidimensionalen KOr- 
per bereit zu halten. Daruberhinaus ist es auch ublich, 
derartige Robot er fur das SchweiBen oder fur das Ein- 
fOgen von Bauteilen in das Gesamtgerat einzusetzen. 
[0003] Hierbei ist es wichtig, die Lage des zu bestuk- 
kenden Bauteils und die Lage des tatigwerdenden 
Roboters mit dem einzufOgenden Bauteil zur Vermei- 
dung von AusschuB aufeinander abzustimmen. 
[0004] Ein derartiges Aufeinanderabstimmen wird 
gemaB der europaischen VerOffentlichung 0489919 mit- 
tels Kalibriertafel mrt Punkten erreicht. Ebenso wird in 
der US-Patentschrift 4639878 eine Abstimmung derge- 
stalt erreicht, daB letztlich einzelne Punkte auf dem zu 
bearbeitenden KOrper mit dem Roboter in Ubereinstim- 
mung gebracht werden. 

[0005] Im Hinblick auf die Verwendung von Punkten, 
sei es an dem zu bearbeitenden Bauteil und/oder in 
Verbindung mit einer Kalibriertafel, welche ebenfalls 
Ober Punkte abgetastet wird, treten Schwierigkeiten 
deshalb auf, weil am zu bearbeitenden Bauteil angeord- 
nete Punkte durch Verschmutzung oder Uberdeckung 
durch andere Bauteile nicht immer sicher erkannt wer- 
den kdnnen, bzw. derartige Punkte gar nicht vorliegen. 
[0006] Ausgehend hiervon liegt der vorliegenden 
Erfindung die Aufgabe zugrunde. ohne Kenntnis der 
gegenseitigen Lage von Werkzeug und Werkstuck bei 
Verwendung eines Roboters ein zielsicheres Arbeiten 
am WerkstOck zu ermOglichen. Diese Aufgabe wird 
gemdB der Erfindung dadurch gelOst, daB aus einer 
Auswahl von mehreren auf dem starren KOrper vorhan- 
denen Linien oder Kanten, die in bezug zum kOrperei- 
genen Koordinatensystem stehen, jede Linie oder 
Kante fur sich in einem ihr zugeordneten. ebenen Koor- 
dinatensystem abgebildet wird und daB die Lage jedes 
ebenen Koordinatensystems auf das raumliche Koordi- 
natensystem bezogen ist. Dabei wird auf eine Zuord- 
nung ausgezeichneter Punkte vOUig verzichtet, so daB 
die Beschrankung auf solche am KOrper iderrtrf izierba- 
ren Punkte vONig entfailt; es kOnnen darflberhinaus 
sogar gekrummte Linien verwendet werden. 
[0007] (n Ausgestaftung dieses erf inderischen Verfah- 
rens wird vorgeschlagen, daB mehrere, auf dem starren 
KOrper vorhandene Linien oder Kanten auf einem ebe- 
nen Koordinatensystem, dessen Lage auf das raumli- 
che Koordinatensystem bezogen ist abgebildet 
werden, und daB anschlieBend entsprechend der 
Bestimmung jeder einzelnen Linie oder Kante nach 
ihrer Lage ein Bezug zwischen raumlichem und kOrper- 
eigenem Koordinatensystem hergestellt wird, und daB 
die Lage dieses KOrpers mit einer entsprechenden 
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Lage in einem anderen KOrper verglichen wird. Durch 
diese erfinderische Ausgestaftung wird trotz Minimie- 
rung im Aufwand eine eindeutige Zuordnung zwischen 
Werkstuck und Werkzeuglage erreicht. Daruberhinaus 
5 wird der EinfluB vorhandener Ungenauigkeiten mini- 
mi ert. 

[0008] Eine Vorrichtung zur DurchfOhrung des Verfah- 
rens mit in einem Raum angeordneten Kameras und 
einem in diesem befindlichen KOrper mit eigenem Koor- 

10 dinatensystem zeichnet sich erfindungsgemdB dadurch 
aus, daB mindestens drei Kanten und/oder Linien auf 
dem KOrper mit einer oder mehreren Kameras erkannt 
wird, daB jede Kamera auf eine andere Kante und/oder 
Linie ausgerichtet ist und daB die gegenseitige Lage 

75 der Kameras kalibriert wird. Hierdurch wird in einfacher 
und schneller Weise ohne vorheriges Aufnehmen von 
Punkten eine gegenseitige Lagebestimmung der 
zusammenzusetzenden KOrper erreicht. In noch weite- 
rer Ausgestaftung der Vorrichtung wird erfindungsge- 

20 maB vorgeschlagen, und zwar gemaB Anspruch 4, daB 
eine kontrolliert bewegbare Kamera im Raum vorgese- 
hen ist. Zufolge der kontrollierten Bewegbarkeit der im 
Raum befindlichen Kamera, welche in bezug zum 
rdumlichen Kbordinatensystem stent, kann diese 

25 Kamera dazu herangezogen werden, die Lage eines 
grOBeren Bauteils im Raum zu bestimmen. 
[0009] In der nachfolgenden Zeichnung wird die Erfin- 
dung an einem AusfOhrungsbeispiel naher eriautert. Es 
wird jedoch darauf hingewiesen, daB es sich nicht nur 

30 zum Deckel in konvexe Behaiter, wie im AusfOhrungs- 
beispiel dargestelrt handeft, sondern daB auch andere 
BauteilzusammenfGgungen unter den Schutzumfang 
der vorliegenden Erfindung fallen, beispielsweise das 
EinfOgen von Bauteilen in ein Fahrzeug, wie TOren. 

35 Fenster, das Auftragen von Kfebe- oder Dichtraupen 
oder das ZusammenfOgen und VerschweiBen raumlich 
gekrOmmter Bauteile im Reaktorbau oder in der Fein- 
werktechnik das ZusammenfOgen in no-man- Betrieb en 
von optischen Bauteilen, ganz allgemein zur Lagebe- 

40 stimmung von Transportmitteln und deren Bauteilen 
beim Zusammenbau. beim Auseinandernehmen oder 
einer Reparatur. 

[001 0] In einem AusfOhrungsbeispiel wird gemaB der 
Figur ein Transportmittel 1 dargestellt, weiches uber 
45 eine FOrdersystem 5 einer Bearbertungsstelle 6 zuge- 
fOhrt wird. 

[001 1 ] Unter Transportmittel sind Transportmittel all er 
Art zu verstehen, wie Flugzeug. Satelit, Schiff, Fahr- 
zeug usw. ; der Ausdruck FOrdersystem steht steflver- 
50 tretend fur alle Arten derartiger Systeme wie 
RoIIbahnen. FOrderbander, SchragaufzOge, Senktrecht- 
fOrderer usw. 

[0012] Die Bearbertungsstelle 6 besteht aus einem 
Roboter 7, welcher heb- und senkbar sowie drehbar 
55 und neigbar ist. Vom Roboter wird im AusfOhrungsbei- 
spiel eine Deckel 8 fur das Transportmittel 1 bereit 
gehaften. Dieser Deckel 8 soil in die hierzu vorbereitete 
Offnung 9 des Transportmittel 1 an der Bearbeitungs- 
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stelte 6 eingefugt werden. 

[0013] Um ein derartiges Eirrfugen auch bei nachfol- 
genden Transportmittel derselben Gattung fehlerfrei im 
Serienbetrieb durchzufuhren, wird gemaB der Erfin- 
dung die Offnung 9 des Transportmittel 1. welche Ober s 
ein kOrpereigenes Koordinatensystem 2 beschreibbar 
ist, von drei Kameras 10, welche ein ebenes Koordina- 
tensystem 3 besitzen und welche zu einem raumlichen 
Koordinatensystem 4 ausgerichtet sind, aufgenommen. 
Hierdurch ist sichergestellt, daB beim gleichen Trans- 10 
portmittertyp das kOrpereigene Koordinatensystem 2 
gleich bleibt und daB somit ein sicheres Einsetzen von 
Deckeln durchgefuhrt werden kann. 
[0014] Auf den Ober Linsen 1 1 aufgenommenen Bil- 
dern auf den ebenen Koordinatensystemen 3 jeder is 
Kamera 10 ist die Zuordnung der Biider zu der jeweili- 
gen Kante zwischen Offnung und Deckel sichergestellt. 
So wird eine linke Kante 12 der Offnung 9 zu einer Bild- 
kante 12a. Eine obere Kante 13 zu einer BikJkante 13a, 
unabhangig davon, welcher Teil der Kanten Ober die 20 
jeweilige Kamera 10 aufgenommen wird. Dieser Wert 
ist dann eindeutig den entsprechenden Kanten des 
Deckels 8 zuzuordnen. 

[0015] Der Verlauf ailer abgebildeten Linien muB der 
bekannten Geometrie des KOrpers entsprechen wenn 25 
die raumlichen Verlaufe aller Linien entsprechend der 
Geometrie des starren KOrpers, in diesem Fade des 
Deckels 8, welche eingefugt werden soli, der Abbildung 
der Kameras und der Kalibrierung der Kameras in 
bezug auf das raumliche Koordinatensystem 4 zur 30 
Bestimmung der Lage des Transportmittels 1 zur Uber- 
einstimmung gebracht worden sind. 
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KOrper verglichen wird. 

Vorrichtung zur DurchfOhrung des Verfahrens nach 
Anspruch 1 und/oder 2 mit in einem Raum ange- 
ordneten Kameras und einem in diesem befindli- 
chen KOrper mit eigenem Koordinatensystem (2) 
dadurch gekennzeichnet, daB mindestens drei 
Kanten und/oder Linien auf dem KOrper mit einer 
oder mehreren Kameras (10) erkannt wird, daB 
jede Kamera (10) auf eine andere Kante Oder Linie 
ausgerichtet ist und daB die gegenseitige Lage der 
Kameras kalibriert wird. 

Vorrichtung nach Anspruch 3 dadurch gekenn- 
zeichnet. daB eine kontrolliert bewegbare Kamera 
(10) im Raum vorgesehen ist. 


Patentanspruche 

1. Verfahren zur optischen Bestimmung der Lage 
eines endlichen starren KOrpers in einem raumli- 
chen Koordinatensystem (4) dadurch gekenn- 
zeichnet, daB aus einer Auswahl von mehreren, auf 
dem starren KOrper vor handenen Linien oder Kan- 
ten, die in bezug zum kOrpereigenen Koordinaten- 
system (2) stehen, jede Linie oder Kante fur sich in 
einem ihr zu-geordneten ebenen Koordinatensy- 
stem (3) abgebildet wird und daB die Lage jedes 
ebenen Koordinatensystems (3) auf das raumliche 
Koordinatensystem (4) bezogen ist 
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Verfahren nach Anspruch 1 dadurch gekenn- 
zeichnet, daB mehrere auf dem starren KOrper vor- 
handene Linien oder Kanten auf einem ebenen 50 
Koordinatensystem (3), dessen Lage auf das raum- 
liche Koordinatensystem (4) bezogen ist, abgebil- 
det werden und daB anschlieBend entsprechend 
der Bestimmung jeder einzelnen Linie oder Kante 
nach ihrer Lage ein Bezug zwischen raumlichem ss 
(4) und kOrpereigenem (2) Koordinatensystem her- 
gesteift wird, und daB diese Lage dieses KOrpers 
mit einer entsprechenden Lage in einem anderen 
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